float32[6] joint
float32 speed
